#ifndef _SERVO_
#define _SERVO_
#include  <msp430g2553.h>

#define SERVODIR P2DIR
#define SERVOOUT P2OUT
#define SERVOPIN BIT3

//#define POS_0 2000
//#define POS_90 4000
#define POS_0 1500
#define POS_90 3000
#define QUANTA 8u
#define SPEED 10


void ConfigureTimer(void);

void enableServo(void);

void disableServo(void);

void setAngle(unsigned char pos);

void setPulse(unsigned int pulse);

#endif



